/* USER CODE BEGIN Header */
/**
  ******************************************************************************
  * @file           : main.c
  * @brief          : Main program body
  ******************************************************************************
  * @attention
  *
  * <h2><center>&copy; Copyright (c) 2019 STMicroelectronics.
  * All rights reserved.</center></h2>
  *
  * This software component is licensed by ST under BSD 3-Clause license,
  * the "License"; You may not use this file except in compliance with the
  * License. You may obtain a copy of the License at:
  *                        opensource.org/licenses/BSD-3-Clause
  *
  ******************************************************************************
  */
/* USER CODE END Header */

/* Includes ------------------------------------------------------------------*/
#include "main.h"

/* Private includes ----------------------------------------------------------*/
/* USER CODE BEGIN Includes */
#include "ssd2828.h"
//#include "R69434.h"
//#include "ST7796S__PH035NA_01B.h"
#include "ST7703__BV055HDE_N47_3Q00.h"

/* USER CODE END Includes */

/* Private typedef -----------------------------------------------------------*/
/* USER CODE BEGIN PTD */

/* USER CODE END PTD */

/* Private define ------------------------------------------------------------*/
/* USER CODE BEGIN PD */
/* USER CODE END PD */

/* Private macro -------------------------------------------------------------*/
/* USER CODE BEGIN PM */

/* USER CODE END PM */

/* Private variables ---------------------------------------------------------*/
UART_HandleTypeDef huart1;

/* USER CODE BEGIN PV */

/* USER CODE END PV */

/* Private function prototypes -----------------------------------------------*/
void SystemClock_Config(void);
static void MX_GPIO_Init(void);
static void MX_USART1_UART_Init(void);
static void MX_NVIC_Init(void);
/* USER CODE BEGIN PFP */

/* USER CODE END PFP */

/* Private user code ---------------------------------------------------------*/
/* USER CODE BEGIN 0 */

int _write(int file, char *ptr, int len)
{
  switch (file)
    {
    case STDOUT_FILENO: //stdout
        HAL_UART_Transmit(&huart1, (uint8_t*)ptr, len, 0xff);
        break;
    case STDERR_FILENO: // stderr 
        // Send the string somewhere
        break;
    default:
        return -1;
    }
    return len;
}

void lcdInitial(void);



/* USER CODE END 0 */

/**
  * @brief  The application entry point.
  * @retval int
  */
int main(void)
{
  /* USER CODE BEGIN 1 */

  /* USER CODE END 1 */
  

  /* MCU Configuration--------------------------------------------------------*/

  /* Reset of all peripherals, Initializes the Flash interface and the Systick. */
  HAL_Init();

  /* USER CODE BEGIN Init */

  /* USER CODE END Init */

  /* Configure the system clock */
  SystemClock_Config();

  /* USER CODE BEGIN SysInit */

  /* USER CODE END SysInit */

  /* Initialize all configured peripherals */
  MX_GPIO_Init();
  MX_USART1_UART_Init();

  /* Initialize interrupts */
  MX_NVIC_Init();
  /* USER CODE BEGIN 2 */

  /* USER CODE END 2 */

  /* Infinite loop */
  /* USER CODE BEGIN WHILE */
  printf("Program Start\r\n");

  // test spi
  /*spi_init();
  while(1)
  {
    spi_write(SPI_CMD, 0xa5);
    HAL_Delay(10);
    spi_write(SPI_DAT, 0x5a);
    HAL_Delay(10);
  }*/
  
  HAL_Delay(1000);

  spi_init();

  ssd2828_hwreset();

  /*ssd2828_writeReg(0xd4, 0x00, 0xfa);

  uint16_t ssd2828ID = ssd2828_readReg(0xb0);
  
  printf("read 2828 id = 0x%x\r\n", ssd2828ID);*/


  /*for(uint8_t i = 0xB0; i < 0xff; i++)
  {
    uint16_t regData = ssd2828_readReg(i);

    printf("reg(0x%02x) = 0x%04x \r\n", i, regData);
  }*/
  //readMipi()

  //Init_SSD2828(init_ST7703__BV055HDE_N47_3Q00);
  lcdInitial();



  while (1)
  {
    /* USER CODE END WHILE */

    /* USER CODE BEGIN 3 */
    /*HAL_GPIO_WritePin(LED_GPIO_Port, LED_Pin, GPIO_PIN_RESET);
    HAL_Delay(1000);
    HAL_GPIO_WritePin(LED_GPIO_Port, LED_Pin, GPIO_PIN_SET);
    HAL_Delay(1000);*/

    //uint8_t dat = 0xa5;
    //HAL_UART_Transmit(&huart1, &dat, 1, 100);
    //HAL_Delay(1000);

    //printf("hello stm32\r\n");
    //HAL_Delay(1000);

    /*HAL_GPIO_TogglePin(LCD_RST_GPIO_Port, LCD_RST_Pin);
    HAL_GPIO_TogglePin(LCD_CS_GPIO_Port, LCD_CS_Pin);
    HAL_GPIO_TogglePin(LCD_MOSI_GPIO_Port, LCD_MOSI_Pin);
    HAL_GPIO_TogglePin(LCD_SCK_GPIO_Port, LCD_SCK_Pin);
    HAL_Delay(1000);*/

    /*if(HAL_GPIO_ReadPin(LCD_MISO_GPIO_Port, LCD_MISO_Pin) == GPIO_PIN_SET) 
    {
      HAL_GPIO_WritePin(LED_GPIO_Port, LED_Pin, GPIO_PIN_SET);
    } else {
      HAL_GPIO_WritePin(LED_GPIO_Port, LED_Pin, GPIO_PIN_RESET);
    }
    HAL_Delay(200);*/

    printf("Loop...\r\n");
    HAL_Delay(1000);

    
  }
  /* USER CODE END 3 */
}

/**
  * @brief System Clock Configuration
  * @retval None
  */
void SystemClock_Config(void)
{
  RCC_OscInitTypeDef RCC_OscInitStruct = {0};
  RCC_ClkInitTypeDef RCC_ClkInitStruct = {0};

  /** Initializes the CPU, AHB and APB busses clocks 
  */
  RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSI;
  RCC_OscInitStruct.HSIState = RCC_HSI_ON;
  RCC_OscInitStruct.HSICalibrationValue = RCC_HSICALIBRATION_DEFAULT;
  RCC_OscInitStruct.PLL.PLLState = RCC_PLL_ON;
  RCC_OscInitStruct.PLL.PLLSource = RCC_PLLSOURCE_HSI_DIV2;
  RCC_OscInitStruct.PLL.PLLMUL = RCC_PLL_MUL16;
  if (HAL_RCC_OscConfig(&RCC_OscInitStruct) != HAL_OK)
  {
    Error_Handler();
  }
  /** Initializes the CPU, AHB and APB busses clocks 
  */
  RCC_ClkInitStruct.ClockType = RCC_CLOCKTYPE_HCLK|RCC_CLOCKTYPE_SYSCLK
                              |RCC_CLOCKTYPE_PCLK1|RCC_CLOCKTYPE_PCLK2;
  RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_PLLCLK;
  RCC_ClkInitStruct.AHBCLKDivider = RCC_SYSCLK_DIV1;
  RCC_ClkInitStruct.APB1CLKDivider = RCC_HCLK_DIV2;
  RCC_ClkInitStruct.APB2CLKDivider = RCC_HCLK_DIV1;

  if (HAL_RCC_ClockConfig(&RCC_ClkInitStruct, FLASH_LATENCY_2) != HAL_OK)
  {
    Error_Handler();
  }
}

/**
  * @brief NVIC Configuration.
  * @retval None
  */
static void MX_NVIC_Init(void)
{
  /* USART1_IRQn interrupt configuration */
  HAL_NVIC_SetPriority(USART1_IRQn, 0, 0);
  HAL_NVIC_EnableIRQ(USART1_IRQn);
}

/**
  * @brief USART1 Initialization Function
  * @param None
  * @retval None
  */
static void MX_USART1_UART_Init(void)
{

  /* USER CODE BEGIN USART1_Init 0 */

  /* USER CODE END USART1_Init 0 */

  /* USER CODE BEGIN USART1_Init 1 */

  /* USER CODE END USART1_Init 1 */
  huart1.Instance = USART1;
  huart1.Init.BaudRate = 115200;
  huart1.Init.WordLength = UART_WORDLENGTH_8B;
  huart1.Init.StopBits = UART_STOPBITS_1;
  huart1.Init.Parity = UART_PARITY_NONE;
  huart1.Init.Mode = UART_MODE_TX_RX;
  huart1.Init.HwFlowCtl = UART_HWCONTROL_NONE;
  huart1.Init.OverSampling = UART_OVERSAMPLING_16;
  if (HAL_UART_Init(&huart1) != HAL_OK)
  {
    Error_Handler();
  }
  /* USER CODE BEGIN USART1_Init 2 */

  /* USER CODE END USART1_Init 2 */

}

/**
  * @brief GPIO Initialization Function
  * @param None
  * @retval None
  */
static void MX_GPIO_Init(void)
{
  GPIO_InitTypeDef GPIO_InitStruct = {0};

  /* GPIO Ports Clock Enable */
  __HAL_RCC_GPIOC_CLK_ENABLE();
  __HAL_RCC_GPIOA_CLK_ENABLE();
  __HAL_RCC_GPIOB_CLK_ENABLE();

  /*Configure GPIO pin Output Level */
  HAL_GPIO_WritePin(LED_GPIO_Port, LED_Pin, GPIO_PIN_RESET);

  /*Configure GPIO pin Output Level */
  HAL_GPIO_WritePin(GPIOA, LCD_RST_Pin|LCD_CS_Pin|LCD_SCK_Pin|LCD_MOSI_Pin, GPIO_PIN_RESET);

  /*Configure GPIO pin Output Level */
  HAL_GPIO_WritePin(GPIOB, SHUT_Pin|U_CON_Pin, GPIO_PIN_RESET);

  /*Configure GPIO pin : LED_Pin */
  GPIO_InitStruct.Pin = LED_Pin;
  GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
  GPIO_InitStruct.Pull = GPIO_NOPULL;
  GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
  HAL_GPIO_Init(LED_GPIO_Port, &GPIO_InitStruct);

  /*Configure GPIO pins : LCD_RST_Pin LCD_CS_Pin LCD_SCK_Pin LCD_MOSI_Pin */
  GPIO_InitStruct.Pin = LCD_RST_Pin|LCD_CS_Pin|LCD_SCK_Pin|LCD_MOSI_Pin;
  GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
  GPIO_InitStruct.Pull = GPIO_NOPULL;
  GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
  HAL_GPIO_Init(GPIOA, &GPIO_InitStruct);

  /*Configure GPIO pin : LCD_MISO_Pin */
  GPIO_InitStruct.Pin = LCD_MISO_Pin;
  GPIO_InitStruct.Mode = GPIO_MODE_INPUT;
  GPIO_InitStruct.Pull = GPIO_NOPULL;
  HAL_GPIO_Init(LCD_MISO_GPIO_Port, &GPIO_InitStruct);

  /*Configure GPIO pins : SHUT_Pin U_CON_Pin */
  GPIO_InitStruct.Pin = SHUT_Pin|U_CON_Pin;
  GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
  GPIO_InitStruct.Pull = GPIO_NOPULL;
  GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
  HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);

}

/* USER CODE BEGIN 4 */
void lcdInitial(void){
  W_C(0Xb7);W_D(0X50);W_D(0X00);	
  W_C(0XB8);W_D(0X00);W_D(0X00);
  W_C(0XB9);W_D(0X00);W_D(0X00);
  W_C(0XBA);W_D(0X14);W_D(0X42);
  W_C(0XBB);W_D(0X03);W_D(0X00);
  W_C(0XB9);W_D(0X01);W_D(0X00);
  W_C(0XDE);W_D(0X03);W_D(0X00);
  W_C(0XC9);W_D(0X02);W_D(0X23);

  GP_COMMAD_PA(0X04);W_D(0XFF);W_D(0XAA);W_D(0X55);W_D(0XA5);W_D(0X80);
  GP_COMMAD_PA(0X03);W_D(0X6F);W_D(0X11);W_D(0X00);
  GP_COMMAD_PA(0X03);W_D(0XF7);W_D(0X20);W_D(0X00);
  GP_COMMAD_PA(0X02);W_D(0X6F);W_D(0X06);
  GP_COMMAD_PA(0X02);W_D(0XF7);W_D(0XA0);
  GP_COMMAD_PA(0X02);W_D(0X6F);W_D(0X19);
  GP_COMMAD_PA(0X02);W_D(0XF7);W_D(0X12);
  GP_COMMAD_PA(0X02);W_D(0XF4);W_D(0X03);
  GP_COMMAD_PA(0X02);W_D(0X6F);W_D(0X08);
  GP_COMMAD_PA(0X02);W_D(0XFA);W_D(0X40);
  GP_COMMAD_PA(0X02);W_D(0X6F);W_D(0X11);
  GP_COMMAD_PA(0X02);W_D(0XF3);W_D(0X01);
  GP_COMMAD_PA(0X06);W_D(0XF0);W_D(0X55);W_D(0XAA);W_D(0X52);W_D(0X08);W_D(0X00);
  GP_COMMAD_PA(0X02);W_D(0XC8);W_D(0X80);
  GP_COMMAD_PA(0X03);W_D(0XB1);W_D(0X6C);W_D(0X01);
  GP_COMMAD_PA(0X02);W_D(0XB6);W_D(0X08);
  GP_COMMAD_PA(0X02);W_D(0X6F);W_D(0X02);
  GP_COMMAD_PA(0X02);W_D(0XB8);W_D(0X08);
  GP_COMMAD_PA(0X03);W_D(0XBB);W_D(0X54);W_D(0X54);
  GP_COMMAD_PA(0X03);W_D(0XBC);W_D(0X05);W_D(0X05);
  GP_COMMAD_PA(0X02);W_D(0XC7);W_D(0X01);
  GP_COMMAD_PA(0X06);W_D(0XBD);W_D(0X02);W_D(0XB0);W_D(0X0C);W_D(0X0A);W_D(0X00);
  GP_COMMAD_PA(0X06);W_D(0XF0);W_D(0X55);W_D(0XAA);W_D(0X52);W_D(0X08);W_D(0X01);
  GP_COMMAD_PA(0X03);W_D(0XB0);W_D(0X05);W_D(0X05);
  GP_COMMAD_PA(0X03);W_D(0XB1);W_D(0X05);W_D(0X05);
  GP_COMMAD_PA(0X03);W_D(0XBC);W_D(0X3A);W_D(0X01);
  GP_COMMAD_PA(0X03);W_D(0XBD);W_D(0X3E);W_D(0X01);
  GP_COMMAD_PA(0X02);W_D(0XCA);W_D(0X00);
  GP_COMMAD_PA(0X02);W_D(0XC0);W_D(0X04);
  GP_COMMAD_PA(0X02);W_D(0XB2);W_D(0X00);
  GP_COMMAD_PA(0X02);W_D(0XBE);W_D(0X80);
  GP_COMMAD_PA(0X03);W_D(0XB3);W_D(0X19);W_D(0X19);
  GP_COMMAD_PA(0X03);W_D(0XB4);W_D(0X12);W_D(0X12);
  GP_COMMAD_PA(0X03);W_D(0XB9);W_D(0X24);W_D(0X24);
  GP_COMMAD_PA(0X03);W_D(0XBA);W_D(0X14);W_D(0X14);
  GP_COMMAD_PA(0X06);W_D(0XF0);W_D(0X55);W_D(0XAA);W_D(0X52);W_D(0X08);W_D(0X02);
  GP_COMMAD_PA(0X02);W_D(0XEE);W_D(0X01);
  GP_COMMAD_PA(0X05);W_D(0XEF);W_D(0X09);W_D(0X06);W_D(0X15);W_D(0X18);
  GP_COMMAD_PA(0X07);W_D(0XB0);W_D(0X00);W_D(0X00);W_D(0X00);W_D(0X08);W_D(0X00);W_D(0X17);
  GP_COMMAD_PA(0X02);W_D(0X6F);W_D(0X06);
  GP_COMMAD_PA(0X07);W_D(0XB0);W_D(0X00);W_D(0X25);W_D(0X00);W_D(0X30);W_D(0X00);W_D(0X45);
  GP_COMMAD_PA(0X02);W_D(0X6F);W_D(0X0C);
  GP_COMMAD_PA(0X05);W_D(0XB0);W_D(0X00);W_D(0X56);W_D(0X00);W_D(0X7A);
  GP_COMMAD_PA(0X07);W_D(0XB1);W_D(0X00);W_D(0XA3);W_D(0X00);W_D(0XE7);W_D(0X01);W_D(0X20);
  GP_COMMAD_PA(0X02);W_D(0X6F);W_D(0X06);
  GP_COMMAD_PA(0X07);W_D(0XB1);W_D(0X01);W_D(0X7A);W_D(0X01);W_D(0XC2);W_D(0X01);W_D(0XC5);
  GP_COMMAD_PA(0X02);W_D(0X6F);W_D(0X0C);
  GP_COMMAD_PA(0X05);W_D(0XB1);W_D(0X02);W_D(0X06);W_D(0X02);W_D(0X5F);
  GP_COMMAD_PA(0X07);W_D(0XB2);W_D(0X02);W_D(0X92);W_D(0X02);W_D(0XD0);W_D(0X02);W_D(0XFC);
  GP_COMMAD_PA(0X02);W_D(0X6F);W_D(0X06);
  GP_COMMAD_PA(0X07);W_D(0XB2);W_D(0X03);W_D(0X35);W_D(0X03);W_D(0X5D);W_D(0X03);W_D(0X8B);
  GP_COMMAD_PA(0X02);W_D(0X6F);W_D(0X0C);
  GP_COMMAD_PA(0X05);W_D(0XB2);W_D(0X03);W_D(0XA2);W_D(0X03);W_D(0XBF);
  GP_COMMAD_PA(0X05);W_D(0XB3);W_D(0X03);W_D(0XD2);W_D(0X03);W_D(0XFF);
  GP_COMMAD_PA(0X06);W_D(0XF0);W_D(0X55);W_D(0XAA);W_D(0X52);W_D(0X08);W_D(0X06);
  GP_COMMAD_PA(0X03);W_D(0XB0);W_D(0X00);W_D(0X17);
  GP_COMMAD_PA(0X03);W_D(0XB1);W_D(0X16);W_D(0X15);
  GP_COMMAD_PA(0X03);W_D(0XB2);W_D(0X14);W_D(0X13);
  GP_COMMAD_PA(0X03);W_D(0XB3);W_D(0X12);W_D(0X11);
  GP_COMMAD_PA(0X03);W_D(0XB4);W_D(0X10);W_D(0X2D);
  GP_COMMAD_PA(0X03);W_D(0XB5);W_D(0X01);W_D(0X08);
  GP_COMMAD_PA(0X03);W_D(0XB6);W_D(0X09);W_D(0X31);
  GP_COMMAD_PA(0X03);W_D(0XB7);W_D(0X31);W_D(0X31);
  GP_COMMAD_PA(0X03);W_D(0XB8);W_D(0X31);W_D(0X31);
  GP_COMMAD_PA(0X03);W_D(0XB9);W_D(0X31);W_D(0X31);
  GP_COMMAD_PA(0X03);W_D(0XBA);W_D(0X31);W_D(0X31);
  GP_COMMAD_PA(0X03);W_D(0XBB);W_D(0X31);W_D(0X31);
  GP_COMMAD_PA(0X03);W_D(0XBC);W_D(0X31);W_D(0X31);
  GP_COMMAD_PA(0X03);W_D(0XBD);W_D(0X31);W_D(0X09);
  GP_COMMAD_PA(0X03);W_D(0XBE);W_D(0X08);W_D(0X01);
  GP_COMMAD_PA(0X03);W_D(0XBF);W_D(0X2D);W_D(0X10);
  GP_COMMAD_PA(0X03);W_D(0XC0);W_D(0X11);W_D(0X12);
  GP_COMMAD_PA(0X03);W_D(0XC1);W_D(0X13);W_D(0X14);
  GP_COMMAD_PA(0X03);W_D(0XC2);W_D(0X15);W_D(0X16);
  GP_COMMAD_PA(0X03);W_D(0XC3);W_D(0X17);W_D(0X00);
  GP_COMMAD_PA(0X03);W_D(0XE5);W_D(0X31);W_D(0X31);
  GP_COMMAD_PA(0X03);W_D(0XC4);W_D(0X00);W_D(0X17);
  GP_COMMAD_PA(0X03);W_D(0XC5);W_D(0X16);W_D(0X15);
  GP_COMMAD_PA(0X03);W_D(0XC6);W_D(0X14);W_D(0X13);
  GP_COMMAD_PA(0X03);W_D(0XC7);W_D(0X12);W_D(0X11);
  GP_COMMAD_PA(0X03);W_D(0XC8);W_D(0X10);W_D(0X2D);
  GP_COMMAD_PA(0X03);W_D(0XC9);W_D(0X01);W_D(0X08);
  GP_COMMAD_PA(0X03);W_D(0XCA);W_D(0X09);W_D(0X31);
  GP_COMMAD_PA(0X03);W_D(0XCB);W_D(0X31);W_D(0X31);
  GP_COMMAD_PA(0X03);W_D(0XCC);W_D(0X31);W_D(0X31);
  GP_COMMAD_PA(0X03);W_D(0XCD);W_D(0X31);W_D(0X31);
  GP_COMMAD_PA(0X03);W_D(0XCE);W_D(0X31);W_D(0X31);
  GP_COMMAD_PA(0X03);W_D(0XCF);W_D(0X31);W_D(0X31);
  GP_COMMAD_PA(0X03);W_D(0XD0);W_D(0X31);W_D(0X31);
  GP_COMMAD_PA(0X03);W_D(0XD1);W_D(0X31);W_D(0X09);
  GP_COMMAD_PA(0X03);W_D(0XD2);W_D(0X08);W_D(0X01);
  GP_COMMAD_PA(0X03);W_D(0XD3);W_D(0X2D);W_D(0X10);
  GP_COMMAD_PA(0X03);W_D(0XD4);W_D(0X11);W_D(0X12);
  GP_COMMAD_PA(0X03);W_D(0XD5);W_D(0X13);W_D(0X14);
  GP_COMMAD_PA(0X03);W_D(0XD6);W_D(0X15);W_D(0X16);
  GP_COMMAD_PA(0X03);W_D(0XD7);W_D(0X17);W_D(0X00);
  GP_COMMAD_PA(0X03);W_D(0XE6);W_D(0X31);W_D(0X31);
  GP_COMMAD_PA(0X06);W_D(0XD8);W_D(0X00);W_D(0X00);W_D(0X00);W_D(0X00);W_D(0X00);
  GP_COMMAD_PA(0X06);W_D(0XD9);W_D(0X00);W_D(0X00);W_D(0X00);W_D(0X00);W_D(0X00);
  GP_COMMAD_PA(0X02);W_D(0XE7);W_D(0X00);
  GP_COMMAD_PA(0X06);W_D(0XF0);W_D(0X55);W_D(0XAA);W_D(0X52);W_D(0X08);W_D(0X03);
  GP_COMMAD_PA(0X03);W_D(0XB0);W_D(0X20);W_D(0X00);
  GP_COMMAD_PA(0X03);W_D(0XB1);W_D(0X20);W_D(0X00);
  GP_COMMAD_PA(0X04);W_D(0XB2);W_D(0X05);W_D(0X00);W_D(0X42);W_D(0X00);W_D(0X00);
  GP_COMMAD_PA(0X06);W_D(0XB6);W_D(0X05);W_D(0X00);W_D(0X42);W_D(0X00);W_D(0X00);
  GP_COMMAD_PA(0X06);W_D(0XBA);W_D(0X53);W_D(0X00);W_D(0X42);W_D(0X00);W_D(0X00);
  GP_COMMAD_PA(0X06);W_D(0XBB);W_D(0X53);W_D(0X00);W_D(0X42);W_D(0X00);W_D(0X00);
  GP_COMMAD_PA(0X02);W_D(0XC4);W_D(0X40);
  GP_COMMAD_PA(0X06);W_D(0XF0);W_D(0X55);W_D(0XAA);W_D(0X52);W_D(0X08);W_D(0X05);
  GP_COMMAD_PA(0X03);W_D(0XB0);W_D(0X17);W_D(0X06);
  GP_COMMAD_PA(0X02);W_D(0XB8);W_D(0X00);
  GP_COMMAD_PA(0X06);W_D(0XBD);W_D(0X03);W_D(0X01);W_D(0X01);W_D(0X00);W_D(0X01);
  GP_COMMAD_PA(0X03);W_D(0XB1);W_D(0X17);W_D(0X06);
  GP_COMMAD_PA(0X03);W_D(0XB9);W_D(0X00);W_D(0X01);
  GP_COMMAD_PA(0X03);W_D(0XB2);W_D(0X17);W_D(0X06);
  GP_COMMAD_PA(0X03);W_D(0XBA);W_D(0X00);W_D(0X01);
  GP_COMMAD_PA(0X03);W_D(0XB3);W_D(0X17);W_D(0X06);
  GP_COMMAD_PA(0X03);W_D(0XBB);W_D(0X0A);W_D(0X00);
  GP_COMMAD_PA(0X03);W_D(0XB4);W_D(0X17);W_D(0X06);
  GP_COMMAD_PA(0X03);W_D(0XB5);W_D(0X17);W_D(0X06);
  GP_COMMAD_PA(0X03);W_D(0XB6);W_D(0X14);W_D(0X03);
  GP_COMMAD_PA(0X03);W_D(0XB7);W_D(0X00);W_D(0X00);
  GP_COMMAD_PA(0X03);W_D(0XBC);W_D(0X02);W_D(0X01);
  GP_COMMAD_PA(0X02);W_D(0XC0);W_D(0X05);
  GP_COMMAD_PA(0X02);W_D(0XC4);W_D(0XA5);
  GP_COMMAD_PA(0X03);W_D(0XC8);W_D(0X03);W_D(0X30);
  GP_COMMAD_PA(0X03);W_D(0XC9);W_D(0X03);W_D(0X51);
  GP_COMMAD_PA(0X06);W_D(0XD1);W_D(0X00);W_D(0X05);W_D(0X03);W_D(0X00);W_D(0X00);
  GP_COMMAD_PA(0X06);W_D(0XD2);W_D(0X00);W_D(0X05);W_D(0X09);W_D(0X00);W_D(0X00);
  GP_COMMAD_PA(0X02);W_D(0XE5);W_D(0X02);
  GP_COMMAD_PA(0X02);W_D(0XE6);W_D(0X02);
  GP_COMMAD_PA(0X02);W_D(0XE7);W_D(0X02);
  GP_COMMAD_PA(0X02);W_D(0XE9);W_D(0X02);
  GP_COMMAD_PA(0X02);W_D(0XED);W_D(0X33);
  GP_COMMAD_PA(0X01);W_D(0X11);
  GP_COMMAD_PA(0X01);W_D(0X29);

  W_C(0XB7);W_D(0X50);W_D(0X00);
  W_C(0XB8);W_D(0X00);W_D(0X00);
  W_C(0XB9);W_D(0X00);W_D(0X00);
  W_C(0XBA);W_D(0X2B);W_D(0X82);
  W_C(0XBB);W_D(0X07);W_D(0X00);
  W_C(0XB9);W_D(0X01);W_D(0X00);
  W_C(0XC9);W_D(0X02);W_D(0X23);
  W_C(0XCA);W_D(0X01);W_D(0X23);
  W_C(0XCB);W_D(0X10);W_D(0X05);
  W_C(0XCC);W_D(0X05);W_D(0X10);
  W_C(0XD0);W_D(0X00);W_D(0X00);
  W_C(0XB1);W_D(0X08);W_D(0X03);
  W_C(0XB2);W_D(0X28);W_D(0X05);
  W_C(0XB3);W_D(0X10);W_D(0X14);
  W_C(0XB4);W_D(0X20);W_D(0X03);
  W_C(0XB5);W_D(0X00);W_D(0X05);
  W_C(0XB6);W_D(0X03);W_D(0X00);
  W_C(0XDE);W_D(0X03);W_D(0X00);
  W_C(0XD6);W_D(0X05);W_D(0X00);
  W_C(0XB7);W_D(0X4B);W_D(0X02);
  W_C(0X2C);  
}
/* USER CODE END 4 */

/**
  * @brief  This function is executed in case of error occurrence.
  * @retval None
  */
void Error_Handler(void)
{
  /* USER CODE BEGIN Error_Handler_Debug */
  /* User can add his own implementation to report the HAL error return state */

  /* USER CODE END Error_Handler_Debug */
}

#ifdef  USE_FULL_ASSERT
/**
  * @brief  Reports the name of the source file and the source line number
  *         where the assert_param error has occurred.
  * @param  file: pointer to the source file name
  * @param  line: assert_param error line source number
  * @retval None
  */
void assert_failed(uint8_t *file, uint32_t line)
{ 
  /* USER CODE BEGIN 6 */
  /* User can add his own implementation to report the file name and line number,
     tex: printf("Wrong parameters value: file %s on line %d\r\n", file, line) */
  /* USER CODE END 6 */
}
#endif /* USE_FULL_ASSERT */

/************************ (C) COPYRIGHT STMicroelectronics *****END OF FILE****/
